#!/usr/bin/python3


import bj
import mpu


def init():
    bj.init_monitor()
    mpu.init_mpu()

def pid(v0):
    

if __name__ == '__main__':
    init()
    while True:
        pu = mpu.get_mpu_data()
        if pu == 0:
            continue
        pu = pu + 43
        print("pu: ", pu)
        # calc output v
        # set bj
